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ABSTRACT 


Ant colony algorithm suffers drawbacks such as slow convergence and easy to trap into 
local optimum, therefore the path planning for mobile robot based on an improved ant 
colony optimization algorithm is proposed. The workspace for mobile robot is established 
with grid method. A hybrid ant colony which is composed of common ants and exploratory 
ants is utilized to avoid trapping into local optimum. To increase the convergence speed, the 
pheromone update mechanism is improved by enhancing the sensitivity of the ants to the 
optimal path with reserving the elite ants. The optimal collision-free path can be planned 
rapidly in the workspace with multiple obstacles. Simulation and experiment results show 
that the algorithm is practical and effective. 
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I. INTRODUCTION 

Mobile robot path planning problem is to find the optimal 
motion path from a given starting point to the end point, 
which satisfies that robots can be safe and collision-free to 
bypass all the obstacles in the process of movement. 
According to the degree of robot mastery of the working 
space environment and the application background, there 
exists multiple methods for path planning. Including artificial 
potential field method [1], fuzzy logic method [2], neural 
network [3] and genetic algorithm [4], etc. The 
disadvantages of artificial potential field method are local 
optimum and local optimization and deadlock problem. 
Fuzzy logic method can overcome the local minimum of the 
potential field method, but with the increase of the input 
quantity, the reasoning rules will expand rapidly. 

Neural network method has good learning ability, but its 
network structure is huge. Genetic algorithm has overcome 
the problem of local minimum, but due to the large amount 
of storage space generated in the process of evolution, the 
operation speed is low. [5] Firstly proposed the ant colony 
algorithm. As the ant colony algorithm has the advantages of 
positive feedback, parallelism and strong robustness, it has 
been widely used for path planning in the different complex 
environments [6-10]. [11] utilized the Global path planning 
as applied to mobile robotics ant colony algorithm as an 
approached in a similar fashion as classic optimization 
problems involving combinational constraints. [12] 
proposed a method of moving target in complex obstacle 
environment, and the navigation path planning of robot is 
carried out based on the improved ant colony algorithm. [13] 


maximized the leading role of the best individuals of ant 
colony to improve the convergence speed of path planning 
algorithm. [14] presented a principle of eliminating the path 
nodes to improve the speed of the algorithm and simplify the 
objective function of traditional path planning. 

In order to solve the problems of the traditional colony ant 
algorithm in sensitivity to the initial value and the tendency 
to fall into local optimum, while maintaining its advantages 
of fast convergence speed, a method of path planning based 
on improved ant colony algorithm is proposed in this paper. 
A hybrid ant colony which is composed of common ants and 
exploratory ants is adopted to avoid the algorithm being 
trapped into local optimum. And we improve the pheromone 
update mechanism to increase the convergence speed. The 
method is suitable for the path planning in complex terrain 
environment. The simulation results show that the method is 
practical and efficient. 

II. ENVIRONMENT MODELLING 

The workspace in this paper is modelled as a grid map, 
which is represented by a collection of discrete cells, as 
shown in Fig. 1. Each grid is given an unique label number. 
The range of activities of ants is a two-dimensional surface 
enclosed within a specified boundary, where a limited 
number of static obstacles are distributed. The active area of 
ants is divided into grids with the same size. A Cartesian 
coordinate system is established to identify the workspace. 
The coordinate of the S-th grid is denoted as 
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(x, y), where x = S ,y = M - [S/JV], M is the 

number of rows in a grid map and N is the number of 
columns in a grid map. 
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III. ROBOT PATH PLANNING METHOD BASED ON 
ANT COLONY ALGORITHM 

Ant colony algorithm is a kind of bionic algorithm, which 
simulates the path planning method foraging behaviour of 
ants. Ants will release pheromones to the environment in the 
process of searching for food. Ants can perceive the 
existence of pheromones in a certain range, and move in the 
direction of high concentration of pheromones. The path of 
high pheromone concentration can attract more ants, which 
shows the phenomenon of positive feedback, and finally the 
whole ant colony can find the optimal path from the nest to 
the food source. 

Artificial ant colony model is utilized to solve the path 
planning problem in this paper. The main characteristics of 
artificial ant colony are as follows. At each iteration, ants can 
only choose the nodes which they have not passed through 
recently to avoid ants going round in circles. Ants choose the 
path according to the transfer probability. After each 
iteration, pheromones of the paths through which ants reach 
the food source are updated. And pheromone will evaporate 
over time. Let m be the number of ants in the ant colony. 
1^- (t)is the pheromone concentration of the path from the 
l —th grid to /-th grid of time t. In the initialization phase of 
the algorithm, letT^- Co) = C, where C is a constant. For the 
k-th ant the probability (t) of time to move from i-th 
grid to j-th grid is defined as follows [5]. 

if_ Tg (t) * 4 o) _ 

W * ^ (&</ j £ allowed k (1) j 


n* - 
Pi} 


0, otherwise 


Where allov/ed k is the set of the remaining feasible states 
of the k-th ant. 7f t j (t) is the local heuristic function of 
visibility. C£ f pl Represent the affecting weight of (t)and 

(t) on the transition probability, respectively. The 
pheromone update formula is defined as follows [5]. 


m. 

At*,- (» - V At*,- (t) 
k= 1 


(3) 


Where p^pf(0^l))is the pheromone evaporation 
coefficient, in At c ^ (t) is pheromone increment of the path 
<i,j> in the current iteration. {t)is pheromone 
increment which the k-th ant release on the pathci, j>. 

at*,-(0= \l U€L A 

(^0, otherwise) 


(4) 


Where Q is a constant, which represents the amount of the 
pheromone increment. L k is the length of the path that the 
k-the ant has passed in the current iteration. 

IV. IMPROVED PATH PLANNING METHOD BASED ON 
ANT COLONY ALGORITHM 
A. Improved Ant Colony Model 

By the path planning method based on ant colony algorithm, 
ants select the path according to pheromone concentration 
on it. The pheromone concentration on a path is associated 
with the number of the ants passing through the path, which 
makes the algorithm easy to trap into local optimum. In 
order to avoid this drawback, a hybrid ant colony which is 
composed of common ants and exploratory ants is adopted 
in this paper. Meanwhile, in order to improve the 
convergence speed of the ant colony algorithm, pheromone 
update mechanism is improved in this paper. At each 
iteration, the ants which have found the shortest path in the 
iteration are labelled as elite ants. The path selection 
mechanism of ant colony algorithm is implemented by 
common ants. The path selection mechanism of exploratory 
ants is defined as follows. For the k-th exploratory ant the 
probability p .j? (t) of time t to move from i-th grid to j-th 

grid is defined as follows. 


Pijit) = J Ireaitourad* »)£ (*)/T“ (0 


■Je allowed h 
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0, otherwise 


Where k allowed is the set of the remaining feasible states of 
the k-th exploratory ant. rf is (t) is the Local heuristic 
function of visibility, which is defined as: 


V i3 0) = -r- 

d v 


( 6 ) 


ct f j$ represent the affecting weight of (t)and?j^- (t)on 

the transition probability, respectively. The pheromone 
update mechanism of elite ants is defined as 

t*/ (t + n) = Cl - p) * (t> + At u (t) + ft) (71 

Where p(pf(0/l))is the pheromone evaporation 
coefficient. In At^- (t) is pheromone increment of common 
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ants which release on the pathci, j> in the current iteration.!?] 
is the pheromone alpha factor of elite ant. A(f) is 

pheromone increment of elite ants which release on the 
pathci, j> in the current iteration. 


Update the pheromone by Eq. (7) 

end while 

end 


At, 




(t) = 


f 


} ^be 

l 0 , 


best 
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Where Q is a constant, which represents the amount of the 
pheromone increment. L best is the length of the path that 
the k-th lite ant has passed in the current iteration. 

B. Improved Ant Colony Algorithm 

We elaborate the improved ant colony optimization (IACO) 
algorithm for path planning as follows. It gives the 
distinction described in Fig. 2. 

Procedure IACO 

begin 

Initialize parameters and pheromone trails 
While (stopping criterion not satisfied) do 
Position each ant in a starting node 
Repeat 

For each ant do 

If (The ant is a common ant) 

Chose next node by Eq. (1) 
endif 

if (The ant is an exploratory ant) 

Chose next node by Eq. (5) 

endif 

endfor 

until (Every ant has build a solution) 
if (The ant is superior than an elite ant) 

Replace the elite ant with the ant 
end if 



Fig. 2The flow chart of the IACO algorithm 


V. EXPERIMENT AND RESULTS 

We have developed three simulated grid examples to evaluate the IACO algorithm for grid scheduling. The experimental 
simulation is designed and implemented based on grid simulation architecture described in section 2.Experimental results are 
compared with the ACO algorithm and PFACO algorithm [15]. The initial parameters are set as follows: 
a = = 1 f p = 03,q = 1. The number of ants is 50 for ant colony algorithm and PFACO algorithm. The number of 

common ants and exploratory ants are 25 and 75, respectively. The number of iterations is 100. 


Table.l parameters of PFACO algorithm 


Parameters 

Value 

Gain coefficient of attractive three k 

15 

Initialization parameter / 

0 

Gain coefficient of repulsive three m 

5 

Obstacle distance Pa 

10 

step lenglli L 

5 

The number ofitenilkms of the artificial potential 
tveLd method./ 

500 


In order to effectively test the performance of the IACO algorithm, multiple sets of test data are used (as shown in Fig.4). 
Experiments are tested for the optimal paths (as shown in Fig.5), convergence rates (as shown in Fig. 6), and the optimal path 
cost (as shown in tab. 2). 
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Fig. 4 Grid environment with obstacle 
(a)10 x 10 grid (b) 20 x 20 grid, (c) 30 x 30 grid, (d) 50 x 50 grid 



Fig.5. Optimal path 

(a) Optimal path achieved by algorithms in 10 x 10 grid 

(b) Optimal path achieved by algorithms in 10 x 10 grid 

(c) Optimal path achieved by algorithms in 20 x 20 grid 

(d) Optimal path achieved by algorithms in 20 x 20 grid. 
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Fig. 6 Comparison of convergence curves 

(a) Convergence curves achieved by algorithms in 10 x 10 grid 

(b) Convergence curves achieved by algorithms in 20 x 20 grid 

(c) Convergence curves achieved by algorithms in 30 x 30 grid 

(d) Convergence curves achieved by algorithms in 50 x 50 grid 


Experimental results show that the convergence speed of ant 
colony optimization algorithm is close to the convergence 
speed of improved ant colony optimization algorithm. With 
the expansion of the scale of the problem, the superiority of 
the IACO algorithm in the convergence speed is gradually 
reflected, he IACO algorithm can plan high quality feasible 
solutions in a short time. For 50 x 50 grid data, the ant 
colony cannot find feasible solutions within the maximum 
number of iterations. The stability of the PFACO is not so 
good. The results of simulation indicate that the improved 
ant colony algorithm is suitable for path planning in complex 
environment, which can find the feasible solution with 
higher convergence speed. 


avoid trapping into local optimum, a hybrid ant colony which 
is composed of common ants and exploratory ants is utilized 
in this paper. By improving the mechanism of updating 
pheromone and preserving the elite ants, the reasonable 
distribution of pheromone is realized, and the convergence 
rate of the algorithm is accelerated. Simulation results prove 
its effectiveness. Experimental results indicate that the 
algorithm is suitable for robot path planning in complex 
environment. 
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